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CHAPTER I 


Introduction 


The objective of this thesis is to present experimental verification of an 
assumed modes model of a large, two link, flexible manipulator that has been 
designed and constructed in the School of Mechanical Engineering at Georgia 
Institute of Technology. The structure was designed to have typical characteristics 
• of a lightweight manipulator. Lightweight structures and lightweight manipulators 
are currently the object of much research [2,3,12,14,18] and are rapidly gaining in 
use. For example, the automotive industry is replacing many steel components 
on automobiles with aluminum or plastics and composite materials. The aircraft 
industry is using a number of lightweight, composite materials for construction 
of wings. In fact, “Composites will account for half the structural weight of the 
Advanced Tactical Fighter” [22]. Generally, lightweight materials are used to reduce 
weight so that performance is enhanced. Where possible, materials are chosen which 
are not only lightweight, but also have good stiffness properties. Good examples 
of these alternative materials include aluminum alloys in place of steel or graphite 
composites in place of aluminum. 

The performance of robotic manipulators can also be enhanced by the use of 
lightweight structural members. Traditional robot manipulators have been designed 
for rigidity instead of strength considerations by using short arm lengths and heavy 
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steel construction in order to achieve positional accuracy and stability of the robot’s 
movements. Lightweight manipulators have a number of advantages over rigid 
manipulators. These include lower power consumption, higher load to weight ratios, 
larger workspaces, and the potential for higher speed operation because of lower 
inertia. In addition, lightweight robots can be more easily designed as self-contained, 
fully mobile units or as semi-permanent units that can be easily transported. 
However, designing structures from the standpoint of strength considerations can 
lead to lightweight structures in which the flexible motions of the manipulator itself 
must, be controlled either by control algorithms or by passive damping. Lightweight 

manipulators use these alternative means to achieve the stability and accuracy 
required. 

In order to implement these control strategies effectively for lightweight 
manipulators, an accurate model of the robot’s structure and dynamics is essential. 
A large amount of work has been done on modeling flexible structures and in 
developing controls for flexible structures [2,3,5,8,10,16]. The majority of that 
work has been applied to single link manipulators or to multiple link manipulators 
with a single flexible link [2,3,11.18]. At Georgia Institute of Technology, a large, 
two link, flexible manipulator has been designed and built for purposes of research 
on modeling methods and control algorithms useful for flexible structures. The 
structure consists of two ten foot links made of aluminum tubing actuated by 
hydraulic cylinders. This large size was chosen to represent realistically a flexible 
manipulator in a region of design space where it would be most competitive, since 
small manipulators can be more easily and economically built to be nearly rigid. 

For modeling the robot arm. two methods have been used. The first method 



uses an “assumed modes” model developed using Lagrangian dynamics. Each of the 
links is modeled as a Bernoulli- Euler beam with two vibration modes. This model 
has its origin in work done by Mirro [12], Book, Whitney, and Maizzo- Neto [6.8,29] 
in the early 1970’s. Their work considered modeling and control of flexible, serially 
connected, two link manipulators and was also based on Lagrangian dynamics. Book 
also later derived the nonlinear equations of motion consisting of rotary joints that 
connect pairs of flexible links [7]. Sangveraphunsiri designed a single link flexible 
manipulator, an optimal controller for that manipulator, and performed some initial 
experiments [42]. Hastings performed more extensive control experiments on the 
same one link manipulator [2], Other work in modeling and control of a single 
link, flexible manipulator has been done by Cannon and Schmitz [30]. Unlike the 
single link case, the derivation of the mode shapes of a multi-link manipulator 
is very difficult using this analytical method since exact boundary conditions are 
hard to determine, the mode shapes are modified by coupling forces from adjacent 
attached links and depend on the configuration of the manipulator and its control 
algorithm. The flexible closed loop chain involved in actuating the second link sets 
this modeling effort apart from most other efforts in the robotics or mechanism 
literature although Matsuno, et al, have presented work on controlling a flexible 
manipulator with a parallel drive [15]. This assumed modes model uses an open 
tree topology in describing the kinematics of the parallel link that actuates the 
upper link of the manipulator incorporating some of the kinematic ideas described 
by Singh, VanderVoort, and Likins [32]. Other kinematic principles developed by 
Turcic, and Midha [33,34], Sunada and Dubowsky [361, Sadler and Sandor [35] and 
Dubowsky and Gardner [37] were also considered in developing the assumed modes 
model. Preliminary work on an assumed modes model used for verification in this 
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thesis was done by Chung [38]. The most recent modeling effort of the two link 
manipulator at Georgia Institute of Technology has been done by Jae Won Lee r 39i. 
An abbreviated derivation of his work is presented in Appendix A. 

A second modeling method, a finite element model, is only used for 
verification of the linear aspects of the assumed modes model. Sunada and 
Dubowsky have applied finite element methods (FEM) to dynamic systems of 
coplanar links [36] and Turcic and Midha have also used the FEM methods for 
dynamic analysis of elastic mechanisms [33,34], however their techniques were not 
applied in the modeling work done here. The advantage of the finite element method 
is that it provides a systematic way of modeling complex geometries with linear small 
motion dynamics. However, because the computations used require large amounts 
of time, it is not practical for realtime control. Since the assumed modes model 
can be reduced in order by making the proper simplifying assumptions and since it 
includes the non-linear effects of the structure such as are encountered during fast 
and large motions, it is the model of choice, but requires verification. It will be the 
model used in other work researching control of flexible structures. 

Measurement methods for verifying small motion dynamics have been in 
use for a number of years. Recent development of the digital signal analyzer 
have made linear analysis of structures much more simple than with analog 
methods. There are many reports on the methods used for finding eigenvalues 
and eigenvectors of structures. The procedures used in this thesis generally 
follow recommendations outlined in Ewins [26] and in Hewlett-Packard's guides 
to vibration testing [27,28]. Generally, a single shaker was attached to the lower 
link and excited with random noise. The resoonse of the manipulator was measured 
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using a piezoelectric accelerometer that was moved to various locations along the 

links. The methods used provided both magnitude and phase information about 

\ 

each mode. Comparison will be made between the eigenvalues and eigenvectors 
measured and those predicted by the linearized assumed modes model and those 
found using FEM methods. 

For nonlinear analysis, there are no ;uch standard methods for analysis. The 
vast majority of analyses done on flexible structures thus far has been done on one 
hnk flexible manipulators [2,3] or on multilink manipulators with a single flexible 
link [18], although Singh, VanderVoort, and Likins have simulated dynamics of 
flexible bodies used in a tree topology [32] and Hughes has presented experimental 
work on the dynamics of a chain of flexible bodies [40]. In this thesis, time domain 
measurements are used for nonlinear comparisons with the assumed modes model. 
Occasionally, the time domain signals are transformed to the frequency domain 
to see if the response of the structure could be approximated by a linear system. 
The comparisons made will be between the actuator displacement, joint angles, and 
strain at the midpoint of each link. 
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CHAPTER n 

Description of Experimental Apparatus 

This robot structure was designed by a master’s student at Georgia Institute 
of Technology for the purposes of research in control and modeling of a viable, full 
size, flexible robot [1]. The design parameters included the following: 

1. A payload of 100 lbs. 

2. Acceleration of the payload at one g. • 

3. To be able to reach second story windows from the ground floor. 

4. Utilize two lightweight links. 

To accomplish the goals of this design, the links were chosen to be ten feet 
long, made from round aluminum tubing. Aluminum tubing was chosen for the 
main structural members because of its high strength-to-weight ratio, its low cost, 
and its ready availability. The lower link is constructed from Schedule 10 pipe 
having a 5.563 inch O.D. with a wall thickness of 0.134 inches. The upper link is 
constructed from Schedule 10 pipe having a 4.50 inch O.D. with a wall thickness of 
0.12 inches. The weights of the links without the sleeves are 26.86 lbs. and 19.40 lbs., 
respectively. The upper link is actuated through a “pusher” link. This “pusher” 
link, hereafter referred to as the actuator link, is constructed from rectangular 
aluminum tubing 4 x 1.75 x .125 inches thick. The links are connected end to end 


using thick sections of aluminum tubing. See Figure 2.1. The joints are constructed 
with steel pins and bronze bushings. For further details about the construction of 
the flexible arm see reference [l] . 



RALF 

(Robotic Arm, Large and Flexible) 
Figure 2.1 


Both links are actuated with single ended hydraulic cylinders. The lower 
link is actuated directly with the cylinder while the upper link is actuated through 
a parallel four bar linkage. The original design was to use brushless DC motors 
together with ball screws to move the links, but hydraulic cylinders were used 
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because of the safety, the low cost of the cylinders compared to the DC motors and 
the ready availability of a hydraulic power unit. Use of hydraulics does introduce 
some nonlinearities, however the modeling of hydraulic servovalves and cylinders 
has been studied in considerable detail. The model used for the actuators follows 
the established procedures [31]. The sizes of the cylinders were chosen from the 
information provided in reference [1]. Figure 2.2 shows the nomenclature that will 
be used in the rest of this thesis. The lower link is actuated with a two inch diameter 
cylinder. The upper link is actuated with a 3.25 inch cylinder. The hydraulic power 
unit can supply 2000 psi at which the amount of force available is 6280 lbs. from 
the s m aller cylinder and 14,140 lbs. from the larger cylinder. 



Nomenclature of Manipulator 

Figure 2.2 



9 


Using hydraulic cylinders limits the range of motion of the robot. The range 
of the shoulder joint (Joint 1) is from 37° to 110° measured from the horizontal. 
The range for the elbow joint (Joint 2) is 55° to 108° when measured relative to the 
lower link. The range of motion for the elbow link measured from the horizontal is 
92° to 145°. These ranges were chosen to provide a more interesting workspace for 
the experiments because the arm can cross over the vertical plane containing the 
axis of the shoulder joint and can reach approximately 200 inches vertically above 
the shoulder joint. See Figure 2.3 for the workspace depiction. 



Manipulator Workspace 

Figure 2.3 


The hydraulic servovalves used are two stage. The first stage is a flapper 
valve, the second is a spool. The flow rate is 5 gpm for both valves. Therefore, 
the maximum linear speed for the shoulder joint actuator is 6.127 in/sec, and 
8.170 in/sec, for extension and retraction, respectively. The maximum speeds for 
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the elbow joint are 2.320 in/sec and 3.268 in/sec, for extension and retraction, 
respectively. The geometric relationship of the actuator’s extension to the joint 
angle rotation results is nonlinear as can be seen in Figures 2.4 and 2.5. 

During testing of the hydraulic cylinders to determine their bandwidth, it 
became apparent that the position control loop was much more stable when the 
measurement of the hydraulic actuator’s position was used for the feedback instead 
of the joint angle. This was caused because the joint angle measurement is not 
located at the same position as the actuator and because the flexibility of the link 
between the actuation point and the measurement point caused a 180° phase shift as 
soon as the structure neared the first system frequency. Figure 2.6 shows the effects 
of the flexible links on the measurement of the joint angle. The transducer mounted 
at the joint reflects the flexible motion, while the LVDT mounted on the actuator 
does not reflect the flexibility of the link. This necessitated the use of LVDT’s for 
feedback of the actuator’s position. The only LVDT’s available on short notice were 
6” long units. A large reduction in the available workspace resulted and limited the 
variety of experiments performed. The dotted line in Figure 2.3 shows the reduced 
workspace. 

Digital 'Control and Data Acquisition 

To verify the nonlinear part of the assumed modes model, it was desired to 
be able to move the manipulator along a prescribe path and to be able to gather 
data while moving. This required a number of tasks to be accomplished. First, the 
transducers and associated amplifiers had to be acquired. Appendix C includes a 
listing of these. The quantities to be measured were: 



THETA DOT vs. THETA 



Angular Velocity vs. Angular Position, Actuator 1 
(at actuator speed, 6.127 in/sec) 

Figure 2.4 


THETA DOT vs. THETA 



Angular Velocity vs. Angular Position, Actuator 2 
(at actuator speed, 2.32 in/sec) 

Figure 2.5 
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Joint Angie Transducer vs. 

Actuator Length Measurements 
Figure 2.6 

1. Joint angles 

2. Joint velocity 

3. Strain in the links 

4. Actuator displacement 

5. Acceleration of points on the links 

6. Differential pressure in the actuator 

All transducers with the exception of the LVDT’s and the accelerometers were 
purchased as new components. These transducers were installed on the existing 
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manipulator and tested using a simple analog controller. (All output from these 
transducers is in analog form.) 

Next, to be able to control the manipulator and gather data from multiple 
sensors simultaneously, control was switched to a Digital Equipment Co. Microvax 
II. The necessary analog/digital (A/D) board was purchased from Data Translation. 
The A/D board came with compiled software routines that could be linked to 
programs written in Fortran. Therefore, the entire program for control and data 
acquisition was written in Fortran. This was written in modular form so that the 
other students in our research group could easily add other path planning and 
control algorithms. Appendix D describes the computer programs in greater detail. 

The program was then tested for speed. In order to effectively implement 
the control algorithm, it was necessary to know the speed at which the A/D board 
could read the eight input channels and output a value on the D/A channel. It was 
found that the A/D board could reliably sample a single channel at 6000 Hz. Eight 
channels could be reliably sampled at only 30.0 Hz. When the control algorithm's 
computations were added to the loop between the data’s acquisition and the control 
output, the frequency of the sampling rate went down to approximately 150 Hz. It 
should be noted that the 150 Hz rate was used for all control used in testing the 
manipulator, regardless of the amount of data required for any particular test. This 
allows consistent path planning to be done. A second A/D board is available on 
the Microvax, but a 1 millisecond delay is required when switching control from one 
board to the next. The second A/D board was not used in any of these experiments. 

Initial verification of the system frequencies and mode shapes was made with 
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a two channel digital analyzer. A second verification was made using software from 
Structural Dynamics Research Corp. (SDRC) called Tdas. To utilize this software, 
Fortran programs were written to gather and catalog time response data from which 
frequency response functions (FRF’s) could be calculated. Then, these data files 
were converted to Tdas readable format by writing a subroutine that, could be 
linked with an SDRC provided program. After the files had been converted, the 
software could be used to create a file containing all the FRF’s for the measurement 
points on the manipulator and to quickly generate the mode shapes and system 
frequencies. 

This conversion of data files also proved to be useful later when comparing 
the results of the experiments and the results of the assumed modes model. By 
choosing an appropriate file format, data could be sent over the campus network 
to the computer where the manipulator’s dynamics were being simulated. The 
predicted results could then be compared directly with the measured results and 
plotted together. Figure 4.3 is an example of this. 
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CHAPTER m 

Linear Modeling, Test Methods and Results 

The first step taken to verify the model was to test, the linear vibration 
characteristics of the structure. The linear behavior for small motions about an 
operating point is one of the most practical comparisons to make between a dynamic 
system and its model. For vibrational systems with light damping, this is equivalent 
to comparisons of the natural frequencies, damping ratios, and system mode shapes. 
This chapter compares the eigenvalues and eigenvectors found from the linearized 
assumed modes model and from two FEM (finite element method) models with those 
experimentally measured. Since the assumed mode shape model results in a drastic 
reduction in order from either the reed system or the finite element model, this 
is especially important for verification of that modeling method. Other analytical 
methods, such as a balanced realization [23], have been applied to choosing the 
model order but these methods assume the high order model to be perfect. This 
structure is complex and imperfect, so that experiments to determine the system 
parameters are essential. A detailed discussion of the modeling methods and the 
experimental methods used follows. 

Linearized Assumed Mode Shape Model 

The following is an excerpt from work done by Jae Won Lee. a PhD. 
candidate at Georgia Institute of Technology. It is included here for completeness. 
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A more thorough derivation of the assumed modes modeling method is included 
in Appendix C. The equation numbers used here refer to the numbers used in 
the appendix. The equations of motion have been derived through application 
of Lagrange’s equations. The assumptions used by the linearized assumed modes 
model are as follows: 

1. All pin joints are perfect, ie., there is no friction in the joints. 

2. The structure is perfectly aligned. 

3. There is no mechanical looseness or slop in any part of the structure. 

4. The hydraulic actuators behave as rigid members. 

5. The joints of the links are connected at the centerline of the adjoining links. 

6. The lower link segments AB and AD are rigid. See Figure 2.2. 

7. The upper link segment EF is rigid. See Figure 2.2. 

8. The area moment of inertia is constant along the entire length of the link. 

9. The boundary conditions axe: 

a. Clamped-mass for the lower link. 

b. Clamped-free for the upper link. 

c. Pin-Pin for the actuator link. 

10. The structure vibrates only in the plane formed by the two links. 
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11. The structure behaves linearly. 

12. The constraint equation includes only the bending of the lower beam. 

The eigenvalues and eigenvectors are obtained from the equations of motion 
of the reduced equations (A. 2. 21) linearized about zero velocity. 

V? MV 2 z + V? KV 2 z = 0 ( .4.3.1 ) 

Eigenvalues of (A. 3.1) are the same as those of the constrained equation (A. 2. 7). 
Eigenvectors of the constrained system are derived by transforming those of (A. 3.1 ) 
using 

q = V 2 z. (.4.3.2) 

For numerical analysis, the selection of mode shape functions is necessary and may 
greatly influence the results. In previous work [10], the natural frequencies were 
derived by the flexible part of the unconstrained equations: 

Mf f q + Kf f q = 0 (.4.3.3) 

but more accurate results were obtained by considering that the lower link bending is 
affected by the actuating link’s rigid motion. The constrained dynamics including 
the actuator link motion is needed. When the actuators axe fixed, velocities of 
joint 1 and joint 2 are zero. New constraint equations between joint 3. joint 4 
and the elastic coordinates are needed. The elements of the mass matrix related 
to joint 1 and joint 2 (columns 1 and 2; rows 1 and 2) are deleted. The dynamic 
equation can then be rewritten as 


V?MV 2 Z + VJ KV,Z = 0. 


(.4.3.4) 
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From these equations, the natural frequencies are calculated. Eigenvectors are 
obtained by the transformation, q = V 2 Z. 

Finite Element Method 

The finite element method is a very useful method especially when it is 
necessary to reconcile the discrepancies between the theoretical model and the 
real system due to the theoretical model’s simplifications. Since the parameters 
of the theoretical model can be easily changed to reflect various degrees of model 
reduction, several sets of parameters can be used in order to determine the amount 
of simplification necessary. In a complex multi-link system, the exact boundary 
conditions are unknown, so that there is no absolute basis for assuming any mode 
shapes for the links. The finite element model provides a method of choosing the 
proper boundary conditions because the dominant mode shapes of each link can be 
found from analysis of the system modes. 

In this dynamic FEM analysis, the large flexible manipulator was modeled 
using linear isotropic three dimensional beam elements and lumped mass elements. 
Therefore, the model allows flexural and axial vibrations in all three axes directions. 
For boundary conditions, the ends of the hydraulic actuators were fixed to the 
ground by pin joints, so that these joints have zero translational displacements and 
only allow rotation about the z-axis. Figure 3.1 shows the nodes and grounding 
points used. All beams and links are connected with pin joints using idealized 
coupled constraints. To describe the pin joints, the coupled constraint conditions 
allow only one rotational degree-of-freedom about the z-axis between the coupled 
nodes at the joints [24]. When only two dimensioned motion was analyzed, the 
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Nodes of the Finite Element Model 

Figure 3.1 

z-axis translational degree-of-freedom and the x and y axes rotational degrees- 
of-freedom were restricted by nodal displacement restraints [24]. The hydraulic 
actuators were modeled as rigid links. The Coulomb friction at the joints and the 
structural damping of the beams were ignored in the dynamic analysis. For dynamic 
analysis, the simultaneous vector iteration method was used to obtain the natural 
frequencies and system mode shapes [25]. 

Two types of finite element models were created: one is a simplified model 
using beam elements with seven different El (modulus of elasticity, area moment 
of inertia) values and one lumped mass element using the same physical dimension 
data and rigidity assumptions as used in the assumed modes model. The other 
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model uses more detailed dimensional data. Beam elements with thirteen different 
El values were used along with three kinds of lumped mass elements so that it more 
closely matches the actual structure. The second model makes no assumptions 
about the rigidity of any of the links - only the hydraulic actuators are assumed 
rigid. In particular, the more detailed model uses exact El values along the length 
of the beam to account for the manipulator’s support sleeves whereas the simplified 
model uses a single El value for the entire length of the beam. The detailed model 
also takes into account the fact that the links are not connected at the centerlines, 
but are connected with offset brackets and includes every lumped mass on the 
manipulator, even the larger steel bolts used for assembly. These two FEM models 
can be used to explain the discrepancy between the assumed mode method and the 
results of the experiment. 

Experimental Procedures for Linear Vibration Analysis 

Literature on vibration testing [26,27 suggests that certain types of input 
are more appropriate than others, particularly when the structures exhibit non- 
linear behavior. Therefore, each of the suggested input methods was tried. The 
methods tried were step relaxation, impact hammers, random noise, burst random 
noise, swept sine, periodic burst chirp, and exciting the structure with the hydraulic 
actuators themselves. Since all of the input methods yielded similar information 
about the eigenvalues, random noise using the electromechanical shaker became 
the input of choice because of its ease of use, its ability to excite the higher 
frequencies, its accuracy, the ability to gather phase information as well as frequency 
information, and the ability to measure the coherence of the signals. Exciting the 
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structure with the hydraulic actuators was judged to be not as accurate as exciting 
the manipulator with the shaker because of the response of the actuator caused a 
small shift in the frequencies measured and because the input force to the structure 
could not be measured directly. 

To verify the small motion dynamics, an electromechanical shaker was 
attached to the structure at the second joint (Point E in Figure 2.2). The structure 
was excited in the frequency range from 1 to 500 Hz. For more detailed information 
about particular system frequencies, the input frequency range to the shaker was 
narrowed to provide better accuracy. The input of the shaker was measured by a 
piezoelectric force transducer installed between the shaker and the lower link. The 
response, acceleration, was measured by a piezoelectric accelerometer. Since the 
force transducer was mounted on the structure at the point of application of the 
shaker, the frequency responses obtained can be attributed only to the shaker input 
and axe independent of any coloration of the dynamics of the electronic driver of 
the shaker. The weight of the force transducer is approximately 25 grams. Its effect 
on the response of the structure is judged small enough to be insignificant. 

To measure the eigenvectors associated with the eigenvalues, each link was 
marked in 6 inch increments. The accelerometer was mounted at the marked 
positions in the plane of links and perpendicular to the links. Figure 3.2 shows 
the location of the measurement points along the links of the manipulator and 
Figure 3.3 shows the typical placement of the accelerometer at each point. The 
structure was then excited with the electromechanical shaker and 30 averages of the 
frequency response were taken to minimize noise effects. The frequency response 
measurements were calculated using the cross spectrum function [28]. This method 
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provides both magnitude and phase information. The correlation of the two signals 
was checked at each measurement point, The frequency response function was 
then integrated twice using the math functions of the digital frequency analyzer to 
obtain a plot of displacement /input force (compliance). As outlined in the Hewlett- 
Packard guide [27] to vibration measurements, the mode shape can be found by 
measuring the imaginary part of the frequency response (provided the structure 

has only proportional damping) at each point along the beam then plotting its 
magnitude. 

The eigenvalue/eigenvector measurement procedure was done twice. The 
first measurements were made using a two channel digital frequency analyzer. This 
was a time consuming procedure because of the number of measurement points used 
to measure the mode shape and because the existence of the out of plane vibration 
modes caused some uncertainty in the measurements. The low frequency vibration 
modes were clearly separated, but the higher system frequencies were obscured 

because of their small magnitude, the out of plane modes and the closeness of the 
frequencies. See Figure 3.4. 

The second set of date was gathered using a Microvax II and an A/D 
board. This allowed gathering time history data directly from multiple points on 
the structure. Using software from the Structural Dynamic Research Corporation 
(SDRC), the time history data was converted to frequency response data. This 
made the task of determining the mode shapes became much easier because the 
software can automatically generate the mode shapes from a series of frequency 
response functions (FRF) stored in the computer. 
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Discussion of Results of Linear Analysis 

Table 3.1 shows a comparison of the system frequencies obtained from each 
of the modeling methods. 

Table 3.1 

System Frequencies 



The first three system modes were easily determined because of their clear 
separation from the other frequencies, but higher frequencies become increasingly 
difficult to analyze because of their much smaller amplitude and the closeness of the 
eigenvalues. Figure 3.4 shows a typical inertance driving point plot of the measured 
frequency response function (FRF). When analyzing the mampulator with the two 
channel analyzer, the comparison of the experimental results with the theoretically 
predicted modes was very useful. The fourth and fifth modes were obscured by 
the out of plane vibrations. The fourth mode was originally overlooked due to its 
small magnitude. By comparison with the finite element model, the fourth mode 
was clearly shown to be dominated by the vibration of the lower link and that 
there was an out-of-plane system mode at a slightly higher frequency. Subsequent 
measurements confirmed both the 57.37 Hz in-plane mode and an out-of-plane mode 
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Driving Point FRF (inertance) 

Figure 3.4 

at 63 Hz. 

Without the theoretical predictions of the natural frequencies and mode 
shapes, it would have been very time consuming to find the higher frequency mode 
shapes, especially since the manipulator being examined here has a number of out- 
of-plane frequencies that are nearly the same frequency and magnitude as the in- 
plane vibrations. Even with the use of the FEM model to help determine the system 
frequencies, the original determination of the mode shapes was found to have some 
small errors in the higher order modes primarily due to the presence of out of plane 
vibrations. Using the SDRC software and the automated method for computing 
the system mode shapes yielded more accurate results than were obtained using the 
two channel analyzer because the complex interaction of the modes of the structure 
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at higher frequencies could be displayed rapidly. Table 3.1 shows a comparison of 
the eigenvalues obtained from each of the modeling methods. Figure 3.5 shows the 
mode shapes of the manipulator and the associated system frequencies. 

As can be seen in Figure 3.5a, the first system mode, at 6.37 Hz, is dominated 
by the first bending mode of the lower link. By using clamped-mass boundary 
conditions, both analytical methods accurately predict this natural frequency and 
mode shape. The second system mode is dominated by the first bending mode of the 
upper link as seen in Figure 3.5b. Using clamped-free boundary conditions in the 
assumed modes model and using the simplified finite element model, there was a 4 
Hz discrepancy with the experimental results When the lower link's geometry was 
modeled more accurately in the detailed finite element model, there was much better 
agreement of this method with the experimental results. It is seen, then, that the 
simplified FEM model (using the same boundary conditions as the assumed model) 
agrees well with the assumed modes model and that the detailed FEM model, using 
no boundary condition assumptions, agrees well with the experimental results. 

The largest discrepancy between the experimentally determined and the 
theoretically predicted natural frequencies occurs in the third and fourth system 
modes. The third system mode is dominated by the pin-pin bending mode of 
the actuator link, but unlike the first two modes, there is nearly a 7 Hz (19%) 
discrepancy between the measured and predicted natural frequencies. However, as 
can be seen in Figure 3.5c, the mode shapes from all three methods correspond well. 
The explanation for this is that the third mode primarily involves the vibration of 
the actuator link. Initially, a tumbuckle with no bearing was used in place of the 
upper link’s hydraulic actuator, which is believed to have caused a large amount of 
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friction in the pin joint causing the joint to exhibit some characteristics of a clamped 
end condition. (The finite element method modeled the link to accurately reflect 
the properties of a turnbuckle rather than those of a hydraulic actuator.) Using the 
FEM method, pin-pin, clamped-pin, and clamped-clamped boundary conditions 
were used for the actuator link. The resulting natural frequencies were 30.1, 46. 
and 64 Hz, respectively. From this, it is concluded that the difference between the 
measured natural frequencies and the predicted ones is most probably due to the 
friction in the joints of the actuator link. 

In the fourth system mode, there is a 6 Hz (10%) discrepancy between the 
measured natural frequency and the frequency predicted by the more detailed finite 
element method. In Figure 3.5d, it can be seen that the fourth mode also involves 
the movement of the segment on the lower beam, AB. Note that the 57.37 Hz fourth 
mode is not predicted accurately by the assumed modes method. The reason for this 
is that the assumed modes method models this section of the lower link as rigid and 
therefore ignores the movement of the lower part of the lower link. Since the fourth 
mode’s movement is dominated by the bending of the lower link, the assumed mode 
method cannot predict this mode accurately. When the simplified finite element 
model was adjusted to reflect the same assumptions used in the assumed modes 
model, the results of these two theoretical methods agreed well. See Table 3.1. 
The assumed modes model has been improved to represent these effects but with 
much increased complexity. The fact that one of the system’s modes was completely 
missed by the assumed modes method shows the importance of verifying theoretical 
results with experiments. In this case, the effect of the fourth system mode is small 
in terms of displacement and it does not significantly affect the movement of the 
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structure. However, the general assumption cannot be made that the higher order 
modes are unimportant or that they can be neglected. 

The fifth system mode, Figure 3.5e, shows that the vibration of the 
manipulator is dominated by the second bending mode of the upper beam. This 
mode is predicted by both the theoretical methods and corresponds well with the 
experimental results. The sixth mode also agrees well among all modeling methods 
and experiments. 

The agreement between the three methods of analysis is substantiated by 
the similar mode shapes found. Figure 3.5 shows normalized mode shapes of the 
structure, but it should be noted that the displacement of the endpoint of the 
upper link is of the same order of magnitude for both the first, and second modes of 
vibration, while the third, fourth, fifth, and sixth’s modes effect on the endpoint of 
the upper link are more than two orders of magnitude smaller than the effect of the 
first two modes. Therefore, for this manipulator, the control of the first two modes 
of the system should be of primary concern to the control designer. 

Change of System Frequencies with Payload and Configuration 

Large, fast motions of the manipulator can result in significant changes 
in configuration. Changes in payload can also dramatically affect the system 
frequencies. A final experimental observation was made in the changes in the system 
frequencies caused by changes in payload and in configuration in preparation for 
verifying the model for nonlinearites. All previous discussion on system modes and 
frequencies were based on a single configuration with no payload. This was mainly 
due to the fact that the structure is so large as to present problems in mounting 
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the electromechanical shaker and accelerometer and because the first two system 
modes are more clearly separated with light payloads. The results are summarized 
follows: 

1 st System Mode 

1. The frequency decreases as payload increases - 6.25 Hz to 3.25 Hz. 

2. The frequency decreases slightly as the manipulator opens - 6.25 Hz to 
6.0 Hz. 

3. The frequency decreases as the joint 1 angle increases - 6.25 Hz to 4.25 Hz. 
2 nd System Mode 

1. The frequency decreases as payload increases - 9.75 Hz to 5.0 Hz. 

2. The frequency is lowest for any given payload when the two links are at right 
angles to each other. 

3. The frequency remains nearly constant for any given payload when only joint 
1 is moving. 

3 rd System Mode 

1. The frequency decreases only slightly regardless of payload or configuration. 

2. The frequency decreases slightly as the manipulator moves to a more open 
configuration - 39 Hz to 36 Hz. 

4 th System Mode 

1. The frequency decreases slightly as the payload increases - 57 Hz to 52 Hz. 

2. The frequency changes little with configuration changes. 

5 th System Mode 

1. The frequency decreases with payload - 94 Hz to 79 Hz. 

2. The frequency decreases as the manipulator opens - 94 Hz to 84 Hz. 

6 th System Mode 

1. The frequency decreases with payload - 120 Hz to 108 Hz. 

2. The frequency decreases as the manipulator moves to a more open configu- 
ration - 120 Hz to 106 Hz. 
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3. The frequency decreases as joint 1 increases - 120 Hz to 110 Hz. 

These results are generally expected from vibration theory. Increased mass 
decreases the system frequencies in every case. Also, increased length decreases the 
system frequencies because the center of gravity of the manipulator is farther from 
joint 1. This effect is seen in all the modes and especially in the first system mode 
when payloads are small. As the payloads become larger, the first system mode rate 
of change becomes significantly smaller relative to the rate of change in joint 1 . In 
fact, as the payloads increase, the rate of change of all system frequencies becomes 
much smaller. The most dramatic changes occur in the first two system modes. 
These are the dominant modes for the system in that these two modes most greatly 
affect the motion of the endpoint. All other system modes effect on the endpoint 
position are more than two orders of magnitude smaller than the effect of the first, 
two system modes. 
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CHAPTER IV 

Non-linear Modeling, Test Methods and Results 

To verify the non-linear aspects of the model, i.e., Coriolis and centrifugal 
effects, large scale, fast motions are needed. To accomplish these motions, control 
of the manipulator wa s implemented on a Micro vax II. This computer was also 
used to gather data during the motion. To compare the results of the experiments 
to the assumed modes model’s results, identical movements were programmed for 
each. Time domain measurements of the joint angles, actuators lengths, actuator 
pressure, and strain in the midpoint of each link were used for comparison. 

Hydraulic Actuator 

As a more detailed model of the manipulator was developed, a more accurate 
model of the hydraulic actuators was needed in order to accurately simulate the time 
response of the manipulator. Texts on hydraulic modeling [31] suggest that a third 
order model of hydraulic actuators is sufficient describe their response up to their 
bandwidth even though the actual order is considerably higher. Two series of tests 
were made to measure the response of the cylinder position to a swept sine input. 
The tests included the open loop response, the closed loop response, and the closed 
loop stiffness response. The procedures usee, closely follow test methods outlined 
in Merritt [31]. The first series of tests were made with the actuator detached 
from the structure. A second series of tests were made with the actuators attached 
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to the structure. A simple proportional only analog controller was used for the 
position loop control. A gain was chosen that would give a margin of stability 
and an appropriate bandwidth. This same gain was then used for all subsequent 
tests. When the digital controller was implemented on a Microvax II computer, an 
equivalent gain was chosen so that experimental results could be directly compared 
to the simulation results. Table 4.1 summarizes the results of these tests of both 
actuators when attached to and detached from the manipulator. It should be noted 
that these tests resulted in a linear model of the actuators. The transfer functions 
for each actuator were found using curve fitting of the Bode and Nvquist plots. 
The equations representing Joint 1 and Joint 2 closed loop actuator dynamics are. 
respectively, as follows: 


(s + 30.37)(s -t- 9 ± jl6.5) 

1 

{s 4- 33,57)(s + 21 ± j23.07) 


(4.1a) 

(4.16) 


Table 4.1 

Summary of Actuator Tests 


Joint 1 Actuator I Joint 2 Actuator 



detached 

attached 

detached 

attached 

Open Loop 
Gain 

127.3 

79.5 

72.2 

51.7 

Closed Loop 
Bandwidth 

18.5 Hz 

17.8 Hz 

18.8 Hz 

17.2 Hz 

Gain Margin 

3.5 db 

10.5 db 

7.5 db 

14.6 db 

Phase Margin 

41.1 deg. 

31.3 deg. 

59.8 deg. 

54.9 deg. 
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Figure 4.1 shows the closed loop Bode plots of the response of the Joint 1 
actuator to the swept sine input both when attached to and when detached from 
the structure. The similarity of these plots shows that the structure's influence 
on the response of the cylinder is small. That is, at the point of attachment, the 
manipulator follows the movement of the actuator very closely. Figure 4.2 shows 
the actual response of the cylinder verses the response computed from a third order 
curve fit. The plots are very similar up to the bandwidth of the actuator. The 
Bode plots for the second joint actuators also show good agreement. Graphs for 
the Joint 2 actuator are included in Appendix B. 

Simulation Results vs. Experimental Results 

Because the low frequency motion of the arm is dominated by hydraulic 
actuator dynamics, the time response of the gross motion of the arm can be derived 
from the frequency response of hydraulic actuator. The calculated time response of 
this transfer function for a sine input and an arbitrary input function match with 
the measured actual path as shown Figure 4.3. 

Assumed Modes Model 

This following is a continuation of the derivation included in Appendix A. 
The equation numbers used refer to those used in the Appendix. The flexible motion 
of the arm is excited by acceleration of the joints. The flexible dynamics are derived 
from (A. 2. 16) 


V?Mq + V?Kq = VjQ 


(A.2.16) 










or 
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Orr Hr, 

M-,r M.„\ 



0 Kr, 

0 K„ 



Flexible motion can be derived as: 



M-fr^r + Kffqf — Qf 
or 

Kffqf + Kf f qf = Qf- K fr q 

where q r are the accelerations of the desired path. 


(A.2.17) 

(4.2a) 

(4.26) 


Experimental Methods 

A variety of movements of the manipulator were used for verification. First, 
the response to a step input was examined to measure the transient dynamics. Next, 
continuous movements that were sinusoidal in joint space were used to. measure 
steady state response. Both the amplitude and the frequency of the sinusoidal 
movements were varied in order to compare the experimental results with the 
predicted results. In both cases a single link was moved first while holding the 
other link fixed. Then both links were moved simultaneously. All of the tests were 
made with no payload because the first two system modes are more clearly separated 
with no loading. 

During the movements of the manipulator, the following measurements were 

made: 

1. Joint angles 

2. Displacement of the cylinders (LVDT) 

3. Differential pressure in the cylinder 

4. Strain at the midpoint in each link 
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Due to the high gains used to increase the closed loop bandwidth, small 
disturbances, such as quantization error, had a large effect on the movements and 
measurements made. The analytical model assumes that there are no disturbances 
and that the structure is ideal. This is never the case with actual systems. The 
effect of each disturbance can be seen in the measurement of the bending strain. In 
this section, these discrepancies will be examined and their causes explained. The 
agreement of the model with the experimental results will also be examined. 

To compare the actual movements with the simulated results, the primary 
measurements were the displacements of the cylinders and the strain measurements. 
The displacement measurements show the rigid body motion. The strain measure- 
ments show the flexible motion. Figure 4.4 shows a typical plot of the experimental 
measurement of strain in the lower link in which the effects of the flexible motion 
can be clearly seen. 

Discussion of Results 

In the following figures, a comparison of the results is shown for one cycle of 
motion. As might be expected, there were some discrepancies between actual and 
predicted results. However, the results showed similar trends and the discrepancies 
can be explained. Generally, the measured strain in the lower link matches the 
strain predicted. The results for the upper link do not match as closely because 
there are no simple theoretical boundary conditions that match the actual boundary 
conditions and because only two mode shapes axe used. Figure 4.5 shows the strain 
in links when both links are moving. 
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Typical Strain Measurement in Lower Link 
Figure 4.4 


In Figures 4.5a and 4.5b the strain in the lower link has the same general 
shape in both the experimental and theoretical results except for the disturbance 
at the peak of the movement. Both plots show that there is little damping in the 
lower link and that the vibration of the upper link has little effect on the vibration 
of the lower link. The disturbance in the measured strain was found to be caused 
by a worn bearing in the actuator cross support (at point C in Figure 2.2). A jump 
in the strain measurements occurs every time the upper link changes direction. The 
j um p is most clearly seen in the strain of the lower link when only the upper link is 
in motion, as is shown in Figure 4.6a, but is noticeable in every measurement. For 
example, Figure 4.5c shows a disturbance in the strain in the upper beam, at the 
same time that the disturbance occurs in the lower beam. 


UCCSEC) 


T»* (SEC) 


Figure 4,5 

Strain of each link when both links moving 

a. Measured strain in upper link 

b. Simulated strain in upper link 

c. Measured strain in lower link 

d. Simulated strain in lower link 


Figure 4.0 

Strain of each link when only lower link moving 
a* Measured strain in upper link 
b. Simulated strain in upper Link 
c * Measured strain in lower link 
d. Simulated strain in lower link 


Comparison of Strain 

Figures 4.5 and 4.6 
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Figure 4.6 shows the strain measurements in the upper and lower links when 
only the upper link is moving. The first discrepancy noticed is the jump in strain. 
Again, this was caused by the mechanical looseness in the actuator cross support. 
The similarity in the strain in the lower link, Figures 4.6a and 4.6b, is that both 
plots show little damping for the cycle of motion. Figure 4.6a shows more effect 
of the upper link’s vibration than is predicted by the model. Figure 4.6b. Figures 
4.6c and 4.6d show the strain in the upper beam. The measured strain in the 
upper beam clearly shows the effect of two disturbances. The first disturbance has 
already been discussed. The second disturbance, point A in Figure 4.6c. occurs 
at the maximum velocity and zero acceleration. A pure inertia load would display 
lost motion (backlash) at this point in the motion cycle. The reversal of differential 
pressure in the cylinder is another possible explanation for the observed disturbance. 
The seal deflection can result in behavior similar to backlash. 

Figure 4.7 shows the control signal to second actuator, strain in the lower link, 
desired actuator position, and actual actuator position when only the upper joint is 
moving. The timing of the events is more obvious on this plot. Measurements of the 
differential pressure in the cylinder show that there is a 150 psi pressure variation 
concurrent with the disturbance. This may seem insignificant, but experience with 
the structure has shown that ciny disturbance seems large because of the large size 
of the structure and the use of large amplification of the strain signals. Figure 4.S 
shows a plot of the differential pressure in the actuator when the input is a pure 
sine wave. As can be seen, there is a disturbance caused by a nonlinearity in the 
valve itself. The jump seen in the pressure measurements is clearly reflected in the 
measurement of strain on the links of the manipulator. Without the effect of these 
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two disturbances, the decrement of the amplitude of the strain in the experimental 
results would match fairly well with the decrement of the predicted strain as shown 
in Figure 4.6c and 4.6d (see the lines bounding the peaks). 

It is obvious from these experiments that the experimental results do not 
exactly match the theoretical results. However, there is enough agreement in the 
general trend of the vibrations and their amplitudes when the disturbances are 
ignored to expect that the experimental results and the theoretical results can match 
if further efforts are made to reduce the disturbances in the experimental data. 
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CHAPTER V 

Conclusions and Recommendations 

The Lagrangian method for developing dynamics equations is very powerful. 
Simple flexible structures can use this method along with a finite number of 
modes to give accurate results. However, geometrically complicated structures, 
such as multilink manipulators and manipulators with parallel drive links, have 
very complicated constraint forces at the joints between the links so that simple 
boundary conditions can no longer be used. In addition, constraint forces, caused 
by redundant links used for strength considerations, change the mode shapes of the 
structure. These complications require that lightweight, flexible manipulators have 
experimental verification and subsequent modification of the system equations to 
provide accurate results. 

As discussed in Chapter III, the eigenvalues and eigenvectors predicted by 
the linearized assumed modes modeling method are not exactly the same as those 
found by the FEM models and from experimental analysis. This was found to be 
primarily due to the simplifying assumptions used by the assumed modes model. 
This could be seen by noting the similarity between the system frequencies and 
modes shapes found with the simplified FEM model to the frequencies and modes 
shapes found using the assumed modes model. Then, as a more detailed FEM 
model was developed, the FEM model’s results were seen to more nearly match 
the experimented results. From this, it can be concluded that the simplifying 
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assumptions used by the assumed modes model contribute heavily to the errors 
found in the system frequencies and modes shapes predicted by this modeling 
method. One solution to this is to use the FEM mode shapes or the experimentally 
determined mode shapes to adjust the parameters used in the assumed modes 
model. 

In Chapter IV, the experimental results are seen to have a considerable 
amount of noise in them due to the imperfect structure and to jerks caused by 
the hydraulic actuators. The assumed modes model does not account for these 
disturbances so that their effect does not appear in the model’s results. Another 
effect measured, but not predicted, is the flexibility of the manipulator between the 
actuator and the joint. The assumed modes model considers this section of the 
structure to be rigid and therefore does not model this behavior. Also, as discussed 
in Chapter IV, the limited workspace and the dominance of the first two system 
modes made it difficult to measure any nonlinear effects of the model. However, 
in spite of these imperfections in the experimental apparatus, the assumed modes 
model and the experimental results show very similar trends in the time domain 
measurements . 

Recommendations 

The assumed modes model can be improved by considering a more detailed 
geometry, however this will greatly increase the complexity of the equations. Better 
results can be obtained by incorporating the experimentally measured mode shapes 
or the FEM model’s mode shapes. Better system frequency and mode shape 
determination may be determined experimentally by moving the shaker to several 
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locations on the manipulator or by using a multiple shaker techniques. Since the 
magnitude of the displacement of the 4 th and higher modes is on the order of 500 
times smaller than the displacement of the first three modes, it may be that the 
model could be truncated after the 3 rd mode. This should be tested by adding 
the experimentally determined mode shapes to the assumed modes model, then 
comparing the new results to measured results. If more accuracy is required, the 
higher order modes can be added to the model. 

For better measurement of the nonlinear aspects of the assumed modes 
model, position transducers capable of measuring the full range of actuator motion 
are needed. The speed of the data acquistion and digital controls implemented on 
the Microvax can be improved by using assembly level routines, but will require a 
considerably higher level of programming skill to implement. To reduce the noise 
caused by disturbances to the structure, more nearly ideal actuators or a more 
sophisticated control algorithm that incorporates an internal force loop around the 
hydraulic actuators themselves is needed. The joints of the manipulator could also 
be inproved by making the diameter of the pins larger and by making the joints 
stiffer, particularly in the out of plane direction. In addition, the base also should 
be enlarged and stiffened because small amounts of flexibility of the base could be 
seen easily in the experimental measurements. Finally, the manipulators structure 
could be modified slightly to make it more ideal and more easily modeled so that 
specific aspects of the dynamic model could be more easily examined without the 
influence of unwanted disturbances. 



APPENDICES 
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APPENDIX A 

Derivation of Constrained Dynamic Equations 

Constrained Equations of Motion 

The following is excerpted from modeling done by Jae Won Lee. a Ph.D. 
candidate at Georgia Institute of Technology. This is the model used in verification 
of the manipulator. 

To analyze a closed kinematic chain system, one joint of the flexible parallel 
link is virtually cut to form an open tree structure. An equation describing the 
constraint force at the point where the cut was made is then required. For this 
manipulator, the cut is made at the joint between the actuating link and the upper 
link. Lagrange’s equations and the assumed mode method is used for deriving the 
equations of motion of this open tree flexible structure. In order to describe the 
motion, the reference frame is defined as shown in Figure A.l. The absolute position 
vectors of am arbitrary point on each link are described by the following: 

r t = Ri + tn + Ufi (.4.2.1) 

where Ri is the position vector of the origin of the reference body with respect 
to the global frame, U r i is the undeformed position vector, and Ufi is the elastic 
deflection vector. Ufi is composed of a linear combination of an admissible shape 
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function, 'P, multiplied by time dependant modal coordinates: 

n 

Vfi (x,<) *„•(*)«/;,(<)• U-2-2) 

Assuming that the amplitude of the higher modes of flexible links axe much smaller 
than the amplitudes of the first two modes, the system can be truncated with n 
equal to 2. 


The kinetic energy, I 7 ,, of each element is obtained from the velocity vector 
of the infinitesimal volume: 

Ti = \p ('?,■?, dV. (.4.2.3) 

The strain energy, which is stored in the flexible mode, can be attributed to the 
elastic stiffness, A*;, which is evaluated by integration over the length of the beam: 

Ki = (EI)i f p"? dx (-4.2.4) 

J i) 


The potential energy, Vi, of each element is composed of the strain energy and 
gravity force: 


v; = 


1 X r* 

2 


(-4.2.5) 


where E is Young’s modulus of elasticity, and I is the area moment of inertia. 


The governing dynamic equations for the system are derived through 
Lagrange’s equations: 

A AT AT AV 

(-4.2.6) 


±,dT _ dT_ _ dV _ 

dt dqj dqj dq ‘ 


The algebraic complexity in applying LagTange’s equation can be overcome using 
a symbolic manipulation program [41 j. The open tree system is constrained by a 
set of nonlinear algebraic constraint equations. These constraint relations can be 
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adjoined to equations (A. 2. 6) using Lagrangian multipliers. The resulting dynamic 
equations can be rewritten in partitioned form in terms of the rigid and flexible 
coordinates: 

fw_ M_,l r^_l Tn n 1 rn 1 

(A.2.7) 


A/rr 

M r f 

9r 

+ o 

0 

\ — 

Qr' 

M fr 

M f /. 

Af . 

K ff. 

s\ — 

[Qfl 


where subscripts r and / denote rigid and flexible coordinates, q is the generalized 
coordinates vector, M is the generalized mass matrix, K is the elastic stiffness 
matrix, is the constraint Jacobian matrix, A is the unknown constraint force 
vector and Q is the generalized force vector including Coriolis, centrifugal and 
gravity forces. The m holonomic constraints are applied to the virtually cut joint 
as 

4>{q) * 0 (A.2.8) 


or 


where 


$ q (q)q = 0 


d* 


{A. 2.9) 




(A.2.10) 

The initial conditions must be consistent with system constraints, therefore: 


q(to) = ?o 


(A.2.11.a) 


and 


9(*o) = 9o 


(A.2.11.6) 


Singular Value Decomposition for Constrained Dynamic Analysis 
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The m x n constraint Jacobian matrix with m < n can be decomposed 
into the form 

= UHV T (A. 2.12) 

or with proper partitioning [31]: 

#, =[F, P 2 ](S„ 0]. (.4.2.13) 

where U, and V t are orthonormal bases for four fundamental subspaces. The 
is equal to diag{&i , <72, . . . , <r m ) where the <x,’s are called the singular values of 
matrix ordered <j\ > > ... > 0. The columns of Li are the orthonormal 

eigenvectors of the symmetric matrix with <r\ the corresponding eigenvalues. 

The columns of Vi are the orthonormal eigenvectors of the symmetric matrix 
It is noticeable that V 2 is the null space of which satisfies the following relation: 

$ g U 2 ==0 (.4.2.14) 

and called the pseudo inverse of , is defined as 

= [ V i V 2 ] £* (.4.2.15) 

Using the nulhty of V 2 , an algorithm which eliminates the constraint forces 
from the equations of motion can be developed. Premultiplication by V', T in equation 
(A.2.7) gives 

V 2 t Mq + V 2 T Kq = V 2 T Q (.4.2.16) 

since $ q V 2 = 0. Because the dimension of equation (A.2.16) is (n — m) x n, an 
additional equation is needed to get the solution. A new variable, z, is defined 
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which is a constrained independent coordinate with dimension n — m. Then \ 2 z is 
the homogeneous solution to equation (A. 2. 9). That is, 

q = V 2 z. (A.2.17) 

Geometrically, equation (A.2.17) is the projection of the velocity vector, q. 
onto the tangent hyperplane of the constraint surface. Similarly, the time derivative 
of equation (A. 2. 9) gives 

$ q q = ~{$ g ) q q 2 . (. 4 . 2 . 18 ) 

Due to the nullspace of $ g , V 2 z is also the homogeneous solution to equation 
(A.2.18). Then q can be written as 

«« ) q q 2 + V 2 z (.4.2.19) 

Physically, the first and second terms on 'he right hand side of equation (A.2.19) 
represent the normal and tangential accelerations, respectively. By integrating 
equation (A.2.17), q is expressed as 

q = V 2 :: + C (.4.2.20) 

where the constant C is chosen as zero to satisfy the constraint equation. Hence, 
the following n — m independent equations can be derived from equations (A. 2. 16). 
(A.2.17) and (A.2.19): 

V? MV 2 z + V? KV 2 z = V?Q + V? j ($,),( V 2 i ) 2 ( A.2.21 ) 

where q and q are calculated using equations (A. 2. 20) and (A.2.17). These are the 
equations used for the nonlinear dynamic simulation. 
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Natural Frequencies and Mode Shapes 

The eigenvalues (natural frequencies) and eigenvectors (mode shapes) are 
obtained from the equations of motion of the reduced equations (A.2.21) linearized 
about zero velocity. 

V?MV 2 z + v7KV,z = 0 (A.z. 1) 

Eigenvalues of (A.3.1) are the same as those of the constrained equation (A.2.7). 
Eigenvectors of the constrained system are derived by transforming those of (A.3.1 ) 

as 

q = V 2 z. ( .4.3.2) 

For numerical analysis, the selection of mode shape functions is necessary and 
may greatly influence the results. Clamped-mass boundary conditions are assumed 
for the lower link mode shape. Clamped-free boundary conditions are used for 
the upper link. Pin-pin boundary conditions are used for the actuating link. In 
previous work [10], the natural frequencies were derived by the flexible part of the 
unconstrained equations: 

Mffq + Kffq = 0 (.4.3.3) 

but more accurate results were obtained by considering that the lower link bending 
is affected by the actuating link’s rigid motion. The constrained dynamics including 
the actuator link motion is then needed. When the actuators are fixed, velocities 
of joint 1 and joint 2 are zero. New constraint equations between joint 3, joint 4 
and the elastic coordinates are needed. The elements of the mass matrix related 
to joint 1 and joint 2 (columns 1 and 2; rows 1 and 2) are deleted. The dynamic 
equation can then be rewritten as 

v?mv 2 z + v?kv 2 z = 0. 


(.4.3.4) 
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From these equations, the natural frequencies axe calculated and the eigenvectors 
are obtained by the transformation, q = V^Z . 
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APPENDIX B 

Derivation of A General Two Link Manipulator 

The task of solving the forward and inverse kinematics of a general two link 
manipulator can be thought of as relating the endpoint of the manipulator to the 
fixed coordinate system having its origin at the axis of the first, joint. This derivation 
assumes that both the links are rigid members. Figure B.l illustrates the coordinate 
system used for this derivation. 
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The following variables are used throughout. 

11 — length of the first link 

12 = length of the second link 

h = of f set between the first link axis and the second joint axis 
Ci = cosine 61 
C 2 = sine 

51 = cosine 6 1 

5 2 = sine 02 

This coordinate transformation is represented by a series of rotations and 
translations in matrix form. These are multiplied together to obtain the total 
transformation for the endpoint. Both the forward and inverse kinematics can be 
found from the total transformation matrix. 


To move a point from the origin to the end of the first link, the following 

two transformations are used. 

• Ci Si 0 0 1 1 0 0 h ~ 

T _ -Si Cl 0 0 010/3 

1 0 0 1 0 0 0 1 0 

.0 0 0 lJ Lo 0 0 1. 

Ci Si 0 (Z,Ci +/3S1) 
rp __ -Si Cl 0 (— llSl + IzCl) 

1 ~ 0 0 1 0 

. 0 0 0 1 

To move from the end of the first link to the end of the second link another rotation 
and translation is made. 

■ c 2 s 2 oo-irioo/ 2 - 

T _ -S 2 C 2 0 0 0 1 0 0 

2 0 0 1 0 0 0 1 0 

.0 0 0 lj LO 0 0 1 . 
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C 2 S 2 0 / 2 C 2 

r _ -S 2 C 2 0 -l 2 S 2 

2 0 0 1 0 

. 0 0 0 1 . 

The total transformation matrix is the product of T, and T 2 . 

<*n a 12 a 13 Ctl 4 

a 2 l Ct 22 Oc 2 3 <*24 

a 31 0:32 <*33 O34 

<*41 <*42 <^43 <*44 

where 

<*n = C'i C 2 — 5]5 2 
Ctl2 = C\S 2 + Si C 2 

013 = 0 

<*14 = ^2( C \ C 2 — S \ S ' ) Z 1 Ci 4- l 2 Si 

0:21 — — { SiC 2 +■ Ci S '\ ) 

0 2 2 ~ Ci C 2 — *S 2 

023 — 0 

a 24 = ~h(SiC 2 + C\S 2 ) — /ji>i 4 - / 3 C 1 
<*31 = 0 

a 32 = 0 
<*33 = 1 

a 34 = 0 

a 4 i = 0 

<*42 = 0 
<*43 = 0 



<*44 = 1 
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The fourth column of the resultant matrix is the displacement vector. Since 
the forward kinematic solution assumes that d\ and 6 2 are known, the X and Y 


positions can be found from the following equations: 

X = l 2 (CiC 2 — S\S 2 ) liC\ I3S1 (5.1) 

y = ~h(SiC 2 d - C\ S 2 ) — I1S1 + l$C\ ( 5.2) 

or using a trigonometric identity, 

A = l 2 ( cos ( $1 + & 2 )) ■+■ /1 C'i + / 3 S] I 5.3 ) 

^ = + S 2 )) — Si + I 3 Ci ( 5 . 4 ) 


It should be noted that 9 2 is measured- relative to the axis of the second link. 

To find the inverse kinematic solution square equations (B. 3 ) and (B. 4 ), then 
add the results together to obtain: 

X 2 + Y 2 = l 2 + l\ + l\ + 2lil 2 C 2 - 2 l 2 l 3 S 2 
Let K = X 2 + Y 2 - l 2 - l\ - l 2 
K = 2hl 2 C 2 - 2Ul z S 2 

Solve for C 2 : 

_ A 4- 2/ 2 / 3 5 2 
2 ~ 21 J 2 

From the trigonometric identity: 

S 2 = C 2 ~ 

Substituting for S 2 and squaring both sides of the equation yields: 

_ K 2 + 4Kl 2 l 3 S 2 + 4l 2 J 2 S; 



61 


Then substitute for C\ to get: 


c2 _ 4 1*% - 4Kl 2 l 3 S 2 -4/2/251 - A' 2 
2 4/2/2 


c -Kh ± ) - a' 2 /? 

5j = 2 mT 4) — x - (B - 5 » 

Due to the direction of the offset / 3 the root of equation (B.5) that is associated 
with the minus sign is the proper solution, so that: 


5-2 = 


_ -A [h ~ V4 (/?/2 + /?/;/ 3 2 ) - 


2/2 ( / j 4" /2 ) 

c = ziivMEtMiz A ' 2 

2 a;, (i; + i|) 

ta „„, = * _ zEi^MSIMSEHR 

Ci Kh -IzVmW+WT^ 1 


( J9.5a 


(5.7) 


Since all of the lengths of the robot arm are known quantities, 0 2 can be found 

by taking the arctangent of the right hand side of equation (B.7). To solve for 9 \ , 

equations (B.l) and (B.2) are rearranged as follows: 

X = C\{ C 2 l 2 + / j ) + S 2 (l 3 — l 2 S 2 ) 

Y = C ,(/ 3 — I2S2) + Si(—l 2 C 2 — /j ) 

Putting these equations into matrix form yields: 

X C 2 / 2 + l 3 / 3 — l 2 S 2 

Y l 3 — l 2 S 2 — / 2 C 2 — h 

Using Cramer’s rule to solve for cos0 x and sin $ 2 : 

(B . 81 

— /j — {C 2 l 2 ) 2 — ll x l 2 C 2 — (/ 3 — l 2 S 2 ) 2 

H<V2 + /i)-X(/ 3 -/ 2 5 2 ) 


(5.8) 


sin^i — 


-l\ ~ (C 2 l 2 ) 2 - 2 hl 2 C 2 - (l 3 - l 2 S 2 ) 2 


tan Q = £1 = F(C 2 / 2 + / 1 )-X(/ 3 -/ 2 5 2 ) 
Ci —X(l 2 C 2 + li) — Y(l 3 — l 2 S 2 ) 


(5.9) 


(5.10) 


Since all the quantities on the right hand 'side of equation (10) are known, 9\ can 
be found using the arctangent function. 



APPENDIX C 


Equipment List 

COMPUTER EQUIPMENT 

Model: Microvax II (VS21W-A2) 

Serial No. WF 61305804 

Company: Digital Equipment Co. 

Boston, MA 


Additional Boards for Microvax 

Model: DT2769-Real Time Clock Board 

Model: DT2785-Analog I/O System (2) 

8 channels A/D multiplexed 
2 channels D/A 
12 bit resolution 

Company: Data Translation 

Canterbury, MA 

Software for Microvax 

IDEAS 

Geomod 
Supertab 
Tdas 

Structural Dynamics Research Corp. 
Cincinnati, OH 


3562A-Digital Signal Analyzer 
2502A00718 
9122-Disk Storage Unit 
2518A44227 
Hewlett-Packard Co. 

San Jose, CA 


Company: 

Signal Analyzers 

Model: 

Serial No.: 
Model: 

Serial No.: 
Company: 


SENSORS 

Model: 
Serial Nos.: 
Resolution: 
Range: 
Company: 


604-000 Angle Transducer (2) 

L-6, L-7 

infinite 

60 degrees 

Transtek, Inc. 

Ellington, Connecticut 
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Part No.: 
Serial Nos.: 
Output: 
Company: 


B1105H3311 Tachometers (with Hall Sensors) (2) 

875308, 875309 

2.6 Volts per 1000 rpm 

Haro we Servo Controls, Inc. 

Pennsylvania 


Model: 
Serial No.: 
Model: 
Serial No.: 
Model: 
Serial Nos.: 
Company: 


308B Accelerometer 
10430 

208A04 Force Transducer 
5978 

480D06 Power Unit (2) 
5163, 5164 

PCB Piezotronics, Inc. 
Depew, NY 


Model: 
Serial No.: 
Model: 
Serial No.: 
Model: 
Serial No.: 
Company: 


4375 Accelerometer 
886208 

2635 Charge Amplifier 
900977 

2651 Charge Amplifier 
488592 ^ 

Bruel & Kjaer Instruments, Inc. 
Marlboro, MA 


Model: EA-13-250MQ-350 Strain Gages 

Company: Measurements Group, Inc. 

Micro-Measurements Div. 

Raleigh, NC 

The graphs at the end of this appendix show the static calibration of the 
strain gages mounted on the lower and upper links, respectively. 


HYDRAULIC COMPONENTS 


Power Unit 

Size: 

Pump: 

Model: 

Company: 


Delco Electric Motor 

25 hp., 230 volts, 60.8 amps, 1755 rpm 

Vickers Variable Volume Piston Pump - 20 gpm 

F3-PVB20-FRS-20-C-11 

Parker Hannifin Corp. 

Aurora, NY 


Valves 

Model: 
Serial Nos.: 
Company: 


73-102A Two Stage Servovalves - 5 gpm (2) 
147, 153 
Moog, Inc. 

East Aurora, NY 


Cylinders 

Model: N2C - 3.25 x 40 Cylinder 

Serial No.: 5C8205-065-1B 



Bore: 

3.25 in. 

Stroke: 

40 in. (modified to 17 in.) 

Seals: 

Buna-N 

Rod Diameter: 

1.75 in. 

Piston Diameter: 

3.25 in. 

Weight: 

52 lbs. 

Company: 

Hydroline Mfg. Co. 
Rockford, IL 

Model: 

H-PB-2 Cylinder 

Serial No.: 

37781-J 

Bore: 

2 in. 

Stroke: 

20 in. 

Seals: 

Teflon 

Rod Diameter: 

1.00 in. 

Weight: 

35 lbs. 

Company: 

Atlas Cylinder C'orp. 
Eugene, OR 
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APPENDIX D 
Computer Programs 

For verifying the nonlinear aspects of the assumed modes model, it was 
important to be able to move the manipulator in a controlled manner along a given 
path and to be able to gather DATA about, that movement at the same time. It 
was decided to implement control and data acquisition on a Digital Equipment Co. 
Microvax II to which A/D and D/A capability had been added. Along with the 
A/D board came compiled software routines that could be called from Fortran or 
C programs. In this work, all programs were written in Fortran. 

Two types of programs were written. The first type was a program to gather 
data only. This was used to verify the system mode shapes and system frequencies. 
The second type of program included path planning for the manipulator, control of 
the movements, and data acquisition. Both programs include the ability to write 
the data to a standard file format. The programs are similar in that they both 
use the Data Translation supplied subroutines to initialize the A/D board and to 
capture the data. The sequence for initializing the A/D boards is as follows: 

1. Include the MicroVms Library at the start of the Fortran program. 

2. Assign a logical name to the A/D board and to the Real Time Clock board. 


3. Call the subroutine DTDEV for each device used, supplying in the CALL 
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argument the logical name of the device. 

4. Set up the A/D board for the number of channels to be used by calling either 
DTALCH, DT1CH, or DTISCN. 

5. Set the gain for all channels by calling DTADGN. 

6. Set up the timing of the Real Time Clock board by calling DTCLOK and 
supplying the appropriate parameters. 

t. Define an array (buffer) that will accept the data by calling the subroutine 
DTSBDB. 

After this, the computer is ready to read in data. The above steps only 
have to be done once for each program. The data is read into the buffer using the 
subroutines DTSBR and DTSBWB. DTSBR reads the A/D channels. DTSBWB 
causes the computer to wait until the buffer is full before proceeding. More 
details about these subroutines can be found in the Data Translation manual 43!. 
After initialization, the DTSBR and DTSBWB routines can be called repeatedly 
to transfer the data. It should be noted that these are referred to in the Data 
Translation manuals as single buffer routines. The manual implies that the 
multibuffer routines are faster. In this case, however, the multibuffer is really only 
a large single buffer that has been partitioned. No increase in speed is seen except 
the routines don’t have to be called repeatedly to gather the same data. Since the 
control algorithms require a sample then time to compute the control effort, the 
multiple buffer routines were judged unsuitable in this case. A single buffer of 8 
was used in programs for controlling the manipulator. A single buffer of 10,000 was 
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Computer Flow Diagram 
Figure D.l 


used for programs that gathered data only. 

Figure D.l shows a simple flow diagram of the computer program used for 
control and data acquisition. After the A 'D board has been initialized, the user is 
prompted for the options for planning the manipulator’s path. The choices are to 
plan the path in joint space, in cartesian space, or in terms of the actuator s position. 
If either the joint space or cartesian space option is chosen, the computer calculates 
the desired path with the options chosen then solves the inverse kinematics to find 
the desired actuator positions at each point along the path. 
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The equations used for this are outlined in Appendix B. If the actuator option 
is chosen, the path is computed directly from the values input from the keyboard. 
In all option cases, the user is prompted for the speed that he wishes to move the 
manipulator along the path. Note that two paths were programmed for these tests. 
The first path is from work done by Oosting [44]. The second is a pure sine wave. 

As the path was computed, the desired actuator displacements were stored in 
an array. The array’s size varies according to the requested speed of the manipulator 
(More values for slower movements, less- values for fast movements). Since the D/A 
board has no provision for timing the analog output, the speed of the A/D input 
had to be used to control the speed of the output. The input/compute cycle time 
length was measured and then included in the path planning algorithm. This is 
inconvenient because as the control algorithm is modified, the time factor also may 
change causing inaccuracies. After all the above steps, the manipulator is ready for 
movement. 

To make a movement, the transducers are sampled, the control is computed, 
and an analog value is output to the power amplifiers that is proportional to the 
error between the planned path’s actuator displacements and the measured actuator 
position. This is repeated until the planned path is completed. The manipulator 
position is maintained until a key is pressed on the keyboard. The user is then 
prompted for another move or to stop the controller. A listing of the computer 
programs is included in a separate report, '‘User’s Guide to Flexible Manipulator 
Control on the Microvax.” The program listings are too long to include in this 
thesis. A more detailed discussion of the control used follows in Appendix E. 
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APPENDIX E 
Manipulator Control 

The controller used for the manipulator is a simple PI controller. This was 
implemented digitally using a zero order hold conversion from the analog equivalent. 
What follows is a discussion of the gains used and the conversions resulting from the 
characteristics of the particular equipment used. Figure E.l shows the simplified 
block diagram of the controller. Figures E.2 through E.4 show more detail of the 
blocks in Figure E.l. 


Desired 



Overall Block Diagram 
Figure E.l 

Because the computer deeds only with numbers, the voltages from the 
transducers must be converted to numbers via the A/D converter. These numbers 
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were then multiplied times a gain and an offset was added to obtain another n um ber 
that represents a physical quantity on the manipulator, the length of the actuator. 

The planned path is a series of numbers representing the desired actuator 
displacement in inches of length. Therefore, to accurately compare the desired 
position with the measured position, the transducer measuring the actuator s 
position had to be converted to inches of actuator position. Assuming the output 
of the transducer is Unear, the equation that represents this is: 

y = mx + b 

where y is the actuator position, x is the transducer voltage, m is the transducer 
gain, and b is an offset. Each time the transducer is mounted, it must be 
calibrated and the computer program modified accordingly. Also each transducer 
has a different gain so that each must be tested to give accurate results. In the 
computer routines used, the subroutine used for performing this calculation is called 
HOMEPOS. A block diagram of this is in Figure E.2. 

length 



Block Diagram of Transducer 

Figure E.2 







Tlie error between the desired position and the measured position is 
multiplied by a gain, K c . This gain is the only value in the control loop that 
is selectable by the user. The computer program prompts the user for the gain. 
Typical values used were 3000 and 9000 for Joint 1 and Joint 1, respectively. These 
values were used to match the digital controller’s gains to those found from frequency 
response tests made with the analog controller. The controller block, then, is very 
simple, as shown in Figure E.3. 



Block Diagram of Controller 
Figure S.3 

where H(z) is: 

K c {z- .9993) 

: — 1 

Notice that the output of the controller is a number proportional to the error. The 
block diagram of the system is examined next. Figure E.4 shows the block diagram 
of the system. 

These are the fixed conversions of the physical components in the apparatus. 
The overall gain for the system subblock is: 

10 .020 5 231 1 .0094 

2048 10 .020 60 ~A^l ~ .4 rea 
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Or. f^y-M 



D /A Current 

Amp 


Block Diagram of the System 
Figure E.4 

The units of the system gain are ^ . The low magnitude of the system 

numerator is the reason for the high gains required by the digital controller. 

Hydraulic Actuators 

The following the Bode plots show the open loop response and closed loop 
response of the hydraulic actuators when detached from the manipulator. From 
these the open loop gains and the closed loop phase and gain margins were 
determined. 
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